أوامر السرعة والتموضع - MC_MoveVelocity، MC_MoveRelative، MC_MoveAbsolute
تم دمج الثلاث وظائف الأكثر استخداماً في البرمجة الآلية:
// MC_Halt - إيقاف مؤقت
MC_Halt_Instance(
Axis := Axis_TO,
Execute := Halt_Cmd,
Done => Halt_Done
);
// MC_Stop - إيقاف تام مع منع الحركة
MC_Stop_Instance(
Axis := Axis_TO,
Execute := Stop_Cmd,
Done => Stop_Done
);
// ملاحظة: MC_Stop يبقى فعالاً طالما Execute = TRUE
تمت إضافة أوامر `Move` داخل الـ FB لاستخراج البيانات التالية من الـ Technology Object:
// استرجاع البيانات من Technology Object Actual_Speed := Axis_TO.ActualSpeed; // RPM Actual_Velocity := Axis_TO.ActualVelocity; // وحدة المستخدم/ث Actual_Position := Axis_TO.ActualPosition; // وحدة المستخدم Standstill := Axis_TO.StatusWord.X2; // إشارة الثبات
إشارة Standstill تخبرك ما إذا كان المحور متوقفاً تماماً. هذا مفيد جداً لضمان سلامة العمليات التالية (مثل فتح قفل الأمان، بدء عملية جديدة).
UDT (User Defined Data Type) هو نوع بيانات مخصص يحتوي على جميع المتغيرات (Inputs/Outputs/Setpoints) الخاصة بالمحور.
// UDT_AxisData Structure
TYPE UDT_AxisData :
STRUCT
// Inputs
Enable : Bool;
Reset_Cmd : Bool;
Home_Cmd : Bool;
Velocity_Cmd : Bool;
Velocity_Setpoint : Real;
Relative_Cmd : Bool;
Relative_Distance : Real;
Absolute_Cmd : Bool;
Absolute_Position : Real;
Halt_Cmd : Bool;
Stop_Cmd : Bool;
Jog_Forward : Bool;
Jog_Backward : Bool;
// Outputs
Axis_Ready : Bool;
Error : Bool;
Actual_Position : Real;
Actual_Velocity : Real;
Standstill : Bool;
// Setpoints
Jog_Velocity : Real;
Acceleration : Real;
Deceleration : Real;
END_STRUCT
END_TYPE
// إنشاء Data Block باستخدام UDT
DATA_BLOCK DB_Axes
// Array of Axis Data
Axis_1 : UDT_AxisData;
Axis_2 : UDT_AxisData;
Axis_3 : UDT_AxisData;
END_DATA_BLOCK
// استدعاء FB لكل محور
FB_Positioning_Axis(
Axis_TO := TO_Axis_1,
Axis_Data := DB_Axes.Axis_1
);
أكد الفيديو على أهمية مراقبة إشارة Done؛ حيث لا يجب إرسال أمر الحركة التالي إلا بعد التأكد من اكتمال المهمة الحالية.
// State Machine with Done signal
CASE State OF
0: // Idle
IF Start_Cmd THEN
MC_MoveAbsolute_Instance(
Axis := Axis_TO,
Execute := TRUE,
Position := 100.0,
Done => Move1_Done
);
State := 10;
END_IF;
10: // Wait for completion
IF Move1_Done THEN
MC_MoveAbsolute_Instance(
Axis := Axis_TO,
Execute := TRUE,
Position := 200.0,
Done => Move2_Done
);
State := 20;
END_IF;
20: // Wait for second completion
IF Move2_Done THEN
State := 0;
END_IF;
END_CASE;
لا ترسل أمر الحركة التالي قبل التأكد من اكتمال الأمر الحالي (Done = TRUE). هذا يضمن تسلسلاً برمجياً (Sequence) آمناً ومستقراً.
// FB_Positioning_Axis - Complete Motion Control Function Block
FUNCTION_BLOCK FB_Positioning_Axis
VAR_IN_OUT
Axis_TO : TO_PositioningAxis;
Axis_Data : UDT_AxisData;
END_VAR
VAR
// Motion Control Instances (Multi-Instance)
MC_Reset_Instance : MC_Reset;
MC_Power_Instance : MC_Power;
MC_Home_Instance : MC_Home;
MC_MoveVelocity_Instance : MC_MoveVelocity;
MC_MoveRelative_Instance : MC_MoveRelative;
MC_MoveAbsolute_Instance : MC_MoveAbsolute;
MC_Halt_Instance : MC_Halt;
MC_Stop_Instance : MC_Stop;
MC_MoveJog_Instance : MC_MoveJog;
// Internal variables
Access_Ready : Bool;
Home_Done : Bool;
Velocity_Done : Bool;
Relative_Done : Bool;
Absolute_Done : Bool;
END_VAR
// ========== 1. MC_Reset ==========
MC_Reset_Instance(
Axis := Axis_TO,
Execute := Axis_Data.Reset_Cmd
);
// ========== 2. MC_Power with Access Ready ==========
IF Axis_TO.StatusWord.X0 AND Axis_TO.StatusWord.X1 THEN
Access_Ready := TRUE;
END_IF;
MC_Power_Instance(
Axis := Axis_TO,
Enable := Axis_Data.Enable AND Access_Ready,
Status => Axis_Data.Axis_Ready,
Error => Axis_Data.Error
);
// ========== 3. MC_Home ==========
MC_Home_Instance(
Axis := Axis_TO,
Execute := Axis_Data.Home_Cmd AND Axis_Data.Axis_Ready,
Position := 0.0,
Mode := 0,
Done => Home_Done
);
// ========== 4. MC_MoveVelocity ==========
MC_MoveVelocity_Instance(
Axis := Axis_TO,
Execute := Axis_Data.Velocity_Cmd,
Velocity := Axis_Data.Velocity_Setpoint,
Acceleration := -1.0,
Deceleration := -1.0,
Done => Velocity_Done
);
// ========== 5. MC_MoveRelative ==========
MC_MoveRelative_Instance(
Axis := Axis_TO,
Execute := Axis_Data.Relative_Cmd,
Distance := Axis_Data.Relative_Distance,
Velocity := Axis_Data.Velocity_Setpoint,
Acceleration := -1.0,
Deceleration := -1.0,
Done => Relative_Done
);
// ========== 6. MC_MoveAbsolute ==========
MC_MoveAbsolute_Instance(
Axis := Axis_TO,
Execute := Axis_Data.Absolute_Cmd,
Position := Axis_Data.Absolute_Position,
Velocity := Axis_Data.Velocity_Setpoint,
Acceleration := -1.0,
Deceleration := -1.0,
Done => Absolute_Done
);
// ========== 7. MC_Halt ==========
MC_Halt_Instance(
Axis := Axis_TO,
Execute := Axis_Data.Halt_Cmd
);
// ========== 8. MC_Stop ==========
MC_Stop_Instance(
Axis := Axis_TO,
Execute := Axis_Data.Stop_Cmd
);
// ========== 9. MC_Jog ==========
MC_MoveJog_Instance(
Axis := Axis_TO,
JogForward := Axis_Data.Jog_Forward,
JogBackward := Axis_Data.Jog_Backward,
Velocity := Axis_Data.Jog_Velocity,
Acceleration := Axis_Data.Acceleration,
Deceleration := Axis_Data.Deceleration
);
// ========== 10. Feedback Data ==========
Axis_Data.Actual_Speed := Axis_TO.ActualSpeed;
Axis_Data.Actual_Velocity := Axis_TO.ActualVelocity;
Axis_Data.Actual_Position := Axis_TO.ActualPosition;
Axis_Data.Standstill := Axis_TO.StatusWord.X2;